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(57) Abstract: A robot collaboration control system includes communication means (21) constituting a network by connecting a 
plurality of control devices (Ca, Cb) for controlling the operation of each of a plurality of robots (Ra, Rb) in a communicable manner, 
input means (37a, 37b) provided on each of 
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DM, DZ, EC, EE, ES, FT, GB, GD, GE, GH, GM, IfR, IIU. 
ID, IL, IN, IS, KE, KG, KP, KR, KZ, LC, LK, LR, LS, IX 
LU, LV, MA, MD, MG, MK, MN, MW, MX, MZ. NO, NZ. 
OM, PH, PL, PT, RO, RU, SC, SD, SE, SG, SI, SK, SL, Tj] 
TM, TN, TR, TT, TZ, UA, UG ; US, UZ, VC, VN, YU, ZA. 
ZM, ZW. 

(84) (JKM): ARJPO *$t* (GH, GM, KE, LS, MW. 

MZ, SD, SL, SZ, TZ, UG, ZM, ZW), 3_ — ^ V7^I1P 
(AM, AZ, BY, KG, KZ, MD, RU, TJ, TM), 3 — P y /< 
(AT, BE, BG, CH, CY, CZ, DE, DK, EE, ES, FI, FR, 
GB, GR, IE, IT, LU, MC, NL, PT, SE, SK, TR), OAPI 



I* (BF, BJ, CF, CG, CI, CM, GA, GN, GQ, GW, ML, MR, 
NE, SN, TD, TG). 



the control devices for inputting operation instructions for each robot, and timing generating means (69a, 69b). Each of the control 
devices is set to an independent function execution mode, a master function execution mode, or a slave function execution mode 
Among the plurality of control devices, the control device (Ca) which is to perform master operation is set to the master function 
execution mode and the remaining control device (Cb) is set to the slave function execution mode. While correcting the minimum 
interrupt cycle (Ts(b)) of the slave side control device (Cb), the control time (tall, tal2, tal3) of the master robot (Ra) by the master 
side control device is delayed by a predetermined time (T) so as to perform collaborating operation. Thus, it is possible to always 
maintain a plurality of robots in a synchronized state, thereby preventing a disagreement between operations of the robots 
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%>o r#icl#0j l±MftmmtiLWPmO*mm?Zgzm%T-&2>o 

^^^2tt s i«fiIPmO*^ogi<SlPml^-/j0D^y h 
Ra£^i&£«fc&©i3Hr?:&?K r LM0VE #lcl#lj hAjj£ti%> 0 aMOVEj 

«a^a&#^^-r^^igT-$,^s r#i c i #lj iiigftp m i^ t§ ^ 

£fc#>©i^-e&Ds rcLOSEj i:IB«5^nSo feU:*^** n*> hR a ©#& 

mz s ^ni&^^M-r^^trfeDs tmasterj tmmzti 
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straps caA^ ©ji^ijs^ u - y^mmn^- pcommmm cbt N 

±f3©<fc?k:3£<>> V&Wl~£A±i£titcib%l£l±, i^lJMjllTs (b) 

*«<u 5*^> h*mz.xxt)£ttifc£%£te, m>bm&frmmTs (b) 

hRa^0»Kital 1, tal2, tal3, ?»^^T 

y:T5B: N T^D^y hR ai:^LTA> h* 3 0 £1B D&fc#)<Dt*Hre 
fc?K ""SIGNAL 2j ^BBf^^o 

TSIGNAL 2:2j ilfB^^tbSo 

^^^7°7(^ #D#nEa, Rb£i&8a»{^£^&#£&©g^DmPm 
2, Ps2Afi^f5fefi)©^^{)s TMLLMOVE #lc2#2,#lc2#2j ^f3«£ 

7ryr81 =&D^yhRa, Rb»Si{4tPm3, Ps3Ag|^ 
•&Sfc«)©^-?r$> tK TMLLMOVE #lcl#3,#lc2#3j £:f3t&£ft&o 

^rf7-9l^ v^pjtfy hRa^©i^lStS^-e»t2>ife«) 
©t^-£fet)s TSWAIT lOOlj hfB«^tL^,o 

X^^n 0fc*x T.V-yuifsy hRb^Am^H]S§4 8 b 
•T^^T'^M^^^fcfeCD^^fe t)s r SWAI 2:1001j hfBffc£*L&o 

^ry711it §D!i?yhRa, Rb^^©ii{4gPm4, Ps4^1 
£^3fc&©T3H^&tK TMLC1M0VE #lcl#4,#lc2#4j £i3t&£n&o 

^ry7-12(is ^DtJ^Ra, R b^SCSlltiPm 5 , Ps5^i 
£*Sfc#>CDifr^-CifeDs ULCIMOVE #lcl#5,#lc2#5j i:fa«£*L£o 

:7°1 3fcfc, #P^hRa, Rb£&©a*5HMPm6, Ps6^» 
*-&Sfc»0#^-C»»3s r MLC2M0VE #lcl#6,#lc2#6j tf3*&£*i3 0 

X^y7-14{As #D#yhRa, Rb^CSIIitSPm?, Ps7^i 
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£**fca&(0l&^T?fc Ds TMLLMOVE #lcl#7 3 #lc2#7j hf3«£*i3o 

^ry7"15(t §D*nRa, R b gfl&gP m 8 , Ps8^1 

£^Sfc&©^-CifetK rMLLM0VE#lcl#8,#lc2#8j ^|B«^tt«o 

r ALONE j £f3tB£;ft£o 

ropENj tmmznzo 

^Ts;718[i s -^On^yfRaCTbt, ^-f v i"ioo2j 
^^ttfctt«8*S6 < Sr**'C^«l^-&*fc»(0#^-t!fel) N rsWAIT 1002j hlB 

^y^l 9fc£. -^D#-^ hRa$^ r#icl#9j 7?*g^^n*a*tt 
«Pm9-siS»j^a6**afca&©#^ , Tffe!j N fLMOVE #lcl#9j tmMZhZo 
Ofc± x — #©n*> hRa*iff»7ttIPml O^&mglt&tci 
4&CDifr<£-*?& D x r H0MEj ^iBa^tL^o 

£©ffe#©n^y hRbffl^n^A t.proram slave( )j fci s l-10©7f 
f75tU EI9©«[Sa*C^$tLSttf^l«ltfl[fiP s Oipe.#<ft*P s 1~P s 
9tItiM7tlPs 1 OtM^m 7l/-7D^'3/ hRbtcHfT^-tf 

^y^lfciu hRacD=§$ft£ftrtf ig^iP s O-x^ffij 

$-e-*fetf>©ttf^#^-C*t) s rjMOVE #lcl#0j i:A*^ti§o tjmovEj «d^* 

#oj ttttf^aanftBP s o a „ 

*^y7"2&s ttf^lS^fiP s Oip&ifcOttgP s l'vffe&OOJjfy hRb 
&#»£*£fcafr©l$hfr-Ci&& % aMOVE #lcl#lj tmMZnZo l~LM0VEj 
*fc»ffrfr*"C& IK r #lcl#lj fct&CD#BP s 1 CDMrc&So 

X^^^3« N HUlB^^^7°2T"?i^b^3igP s 1TV\> h'3 0£E!3b£-& 
SfctoOifr^T&tK TCLOSEj ttZMZtlZo M±&X\s-7n7Fy 
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^fy74tts WDtC^hRbM^ Ti002j T-*Ba*£:h,*&# 
£«ar3£^f#*S£^3fcfc©ifr^"efc^ ""SWAIT 1002j JilBfii^n^o 

flr^TffctK f SLAVE j i:f3«fi^n^o C©7'n^7 ACD^fxBSfc^Ttefcs XI/ 
-^D**y hRbiis TX^o^v h R a{I]/b>e>©=g-x^y 7" 5 ~ 1 5©i^fc: 
jfo»bTt&WS&fF t &fT-5o ^©ttWttf^Wftts itujz£bfc<fc5f^ TOOLS' h 

^rC&tK TALONEj hf3i££*L&o 

^rf77iis flfc^CDP^y hRb0A> I 5 3 0£gg< fc&tDfltM^fe tK • 
fOPENj hmm>-£tL2> 0 

X7-y78\±, TX^D^y bR a&^XW — r/ntfy hRb©I^fcMt 
TJB^*ffl»Jfc^ - rSfc«)©^*tf*?)N r SI6NAL 2j hlBt^ft^o 

^r^79i±s flliSCDJPy hRb£^gfc£ r#i c 2#9j T'^£ft3S1fM4S 
Ps9A^t5fc»0#^feD> TLMOVE #lc2#9j ^IBK^tL^o 

&©#^rT*ifc ?K fHOMEj £S3«&£ft£o 

SCa£A££ti£o ^©v^^iii^- ail AJiXstzW} 

ffcJM*fcJfc* bT$J#?f&#&flfT U u^UX U— ^«M««E« CbiP&Ctt 
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— \*temfegtitzmmmwcb(Dx&ij\M\m (m»io) 4 8b»^&b 

^fl!lM0^i:CboAtB^iasS4 8a§ffl^SC!:i:trJ;oT> 
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m $t (D is a 

^s-teiw^afciew&nx HuiB*/j^ja^M«Bt?^>r $>^«-9*»£-r**-f 
mn^-Ftemfei<ntzmmmwftMtfm^*mmvtzmm (ta) ^e.tuiB^ 

#v h<Dfflffl&Mifeirzmm (tb) ST»©M{f@tbM (tb-ta) # N ^ 

#>^#>3ra (t) t&si^fcs buibxix— ym^mn^—Ynm^titcm 
mmw<z>m>b#)&frmm (ts (b) ) *«fc3«£ks#*fcfauraKBi 
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3. m&^tbfe&znm (T) & N =&$iJfP^S©W)l^ (W) WTfclH 

rntimm (tb-ta) tdimm£&Tmm?zz£*&mtirzm&m3tm 



mm^x^mmmn^- ^izm^titzmmmm^ mmMmm^m^vx 

m 1 ~ 5 © v ^ -r n^— is 1 1 am © d ^ h ©^is^ijfp x ^ a 0 
^{cA^^ti^ h t & iz, n&(Dfflm^mzmzmmmm^®*ftvxA±>zn, 
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FIG. 7 




FIG. 8 
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PROGRAM master() 

1 JMOVE #1c1 

2 LMOVE #1c1 

3 CLOSE 

4 MASTER 

5 SIGNAL 2 

6 SIGNAL 2:2 

7 MLLMOVE #1c1 

8 MLLMOVE #1c1 

9 SWAIT 1001 

10 SWAIT 2 : 1001 

11 M LCI MOVE #1c1 

12 MLC1MOVE #1c1 

13 MLC2MOVE #1c1 

14 MLLMOVE #1c1 

15 MLLMOVE #1c1 

16 ALONE 

17 OPEN 

18 SWAIT 1002 

19 LMOVE #1c1 

20 HOME 
END 



0 
1 



2, #1c2_2 

3, #1c2_3 



4, #1c2_4 

5, #1p2_5 

6, #1c2_6 

7, #1c2_7 

8, #1c2_8 



PROGRAM slave() 

1 JMOVE #1c2_0 

2 LMOVE #1c2_1 

3 CLOSE 

4 SWAIT 1002 

5 SLAVE 

6 ALONE 

7 OPEN 

8 SIGNAL 2 

9 LMOVE #1c2_9 
10 HOME 

END 
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